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MOTOR CONTROL DEVICE 

BACKGROUND ART 
Fig. 6 is a conceptual view of the configuration of a generally 
used conventional speed control device for a motor. In the figure, 
reference numeral 1 denotes a motor, reference numeral 2 denotes a 
load driven by the motor, and reference numeral 3 denotes an axle 
connecting the motor 1 and the load 2. The load 2 represents a 
moveable member of a machine driven by the motor 1, modeled as an 
inertial load, and the axle 3 models a mechanism for transmitting 
torque, generated by the motor 1, to the machine. Reference numeral 
4 denotes an encoder, attached to the motor 1, for detecting the 
position of the motor 1, reference numeral 5 denotes a speed detection 
means for computing motor speed by differentiating, the motor 
position detected by the encoder 4. Reference numeral 6 is a 
comparator for comparing a speed command signal given by a 
high-level controller (not illustrated in the figure) with the motor 
speed output by the speed detection means 5, and for outputting the 
difference between these two speeds as a speed error. Reference 
numeral 7 is a speed control means that, with the speed error output 
by the comparator 6 as input, outputs an electrical current command 
that is a motor drive command. Reference numeral 8 is an electrical 
current control means that, by controlling the motor electrical current 
based on the electrical current command output by the speed control 
means 7, generates torque in the motor and rotates the motor. 
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The speed control means 7 is composed of a proportional 
controller 9, an integral controller 10, and an adder 11. The 
proportional controller 9 multiplies the input speed error by 
proportional gain KP and outputs the result; and the integral 
5 controller 10 multiplies the integral value of the speed error by 
integral gain KI and outputs the result. The adder 11 adds the 
proportional controller 9 output and the integral controller 10 output, 
and outputs the result as the electrical current command. Reference 
numeral 15 is a mechanical system and is comprised of the motor 1, 

10 the load 2, and the axle 3. 

A conventional speed control system is configured as 
described above,* the torque for accelerating or decelerating the motor 
1 is generated so that the speed error, being the difference between 
the speed command signal and the motor speed, becomes small, and 

15 thus the motor 1 and the load 2 rotate so that the motor speed follows 
the speed command signal given by the high-level controller. In cases 
where disturbing torque acts in the mechanical system, the motor 
speed fluctuates due to the disturbing torque; however, this speed 
fluctuation is detected by the encoder 4 and the speed detection 

20 means 5, is fed back to the speed control means 7, and an electrical 
current command is generated to correct the speed fluctuation. In this 
way, even in cases where disturbing torque acts, the speed 
fluctuations are restrained by a speed control loop, and the motor is 
controlled so as to follow the speed command signal. 

25 Fig. 7 illustrates frequency response for an open speed loop in 



a configuration for a speed control system using a conventional speed 
control device. Frequency response for a speed open-loop are 
frequency response from the input of the speed control means 7 to the 
motor speed detected by the speed detection means 5; the upper graph 
in Fig. 7 illustrates gain characteristics and the lower graph 
illustrates phase characteristics. The broken lines in the figure 
illustrate frequency response for cases where the rigidity of the axle 3 
connecting the motor 1 and the load 2 is high, that is, the mechanical 
rigidity is high. The full lines illustrate frequency response for cases 
of mechanical resonance, where the mechanical rigidity is low because 
the rigidity of the axle 3 is low. 

Gain characteristics for cases where the mechanical rigidity 
is high (the rigidity of the axle 3 is high), as illustrated by the broken 
line in the upper graph of Fig. 7, drop down towards the right, over 
all frequencies. As illustrated by the broken line in the lower diagram 
of Fig. 7, at high frequencies, phase lags become large due to phase 
lags resulting from the sample period of the electrical current control 
means 8 or the control device; and at low frequencies, phase lags also 
become large due to using the integral controller 10 in the speed 
control device 7. 

On the other hand, in cases where the mechanical rigidity is 
low (the rigidity of the axle 3 is low), the mechanical system has a 
mechanical resonance, and, as illustrated by the full line in the upper 
diagram of Fig. 7, its gain characteristic has a resonance referred to 
as a peak and an anti-resonance referred to as a trough. Since the 



gain decreases to the left, between resonance and anti-resonance, the 
gain at low frequencies becomes small in comparison to cases where 
the rigidity of the axle 3 is high (the broken line). As the inertial 
moment J of the whole mechanical system, being the sum of the 
inertial moment of the motor 1 and the inertial moment of the load 2, 
becomes large in comparison to the inertial moment JM of the motor, 
the distance between the resonance and the anti-resonance increases 
and the frequency of the anti-resonance becomes low, so that the low 
frequency gain becomes even smaller. 

In order to realize high accuracy speed control, it is necessary 
to curb the influence of the disturbing torque that is one of the causes 
of the speed error, and to make small the speed fluctuations when the 
disturbing torque acts. In general, since the disturbing torque has low 
frequency signal components, in order to make small the speed 
fluctuations due to the disturbing torque, it is necessary to enlarge 
the gain at low frequencies. However, with machines having low 
rigidity, since the gain is small at low frequencies as described above, 
the speed fluctuations due to the disturbing torque become large and 
high accuracy control becomes difficult. 

To enlarge the gain at low frequencies in the conventional 
speed control devices illustrated in Fig. 6, it is necessary to enlarge 
the proportional gain KP and the integral gain KI of the speed control 
means 7. However, there is a limit to this, and ultimately high 
accuracy control could not be realized. The reason for this is explained 
below. In Fig. 7, the frequency, where the gain characteristic for low 



rigidity cases (full line) intersects the line for 0 db gain at frequencies 
lower than the anti-resonance frequency, is a first crossover frequency 
(oCl, and the frequency where it intersects the line for 0 db gain at 
frequencies higher than the resonance frequency is a second crossover 
frequency qC2. In order that the control system operates stably 
without causing vibrations or oscillating, it is necessary that the 
speed open-loop frequency characteristic phase lags be small for the 
first crossover frequency (oCl and the second crossover frequency coC2. 
However, when the proportional gain KP is made large, since the 
second crossover frequency g)C2 shifts to the high frequency side, the 
phase lag for the second crossover frequency (oC2 becomes large and 
the control system ends up vibrating and oscillating. When the 
integral gain KI is made large, since the phase lag at low frequencies 
due to the integral controller 10 becomes large, the phase lag for the 
first crossover frequency qCI becomes large, and the control system 
ends up vibrating and oscillating. In this way, since for the 
conventional speed control device it is not possible to enlarge the 
proportional gain KP or the integral gain KI beyond a certain amount, 
the gain at low frequencies cannot be made large, and as a result high 
accuracy control has been difficult. 

Servo control technology directed towards mechanical 
systems having mechanical resonance is disclosed in Japanese 
Laid-Open Patent Publication 2000-322105. Fig. 8 illustrates a speed 
control device using this technology. The same reference numerals are 
used for members that are the same as in Fig. 6. In Fig. 8, reference 



6 



numeral 12 is a filter inserted serially in the speed control loop and 
has a reverse characteristic or a proximately reverse characteristic to 
the anti-resonance/resonance characteristic of the mechanical system. 
This filter is adjusted to exhibit a characteristic such as that 
5 described in equation (l). 

G(s)-Ql2(s2+2^2<*>2 S +Ca2')/W2'(s '+2^10)1 S +(01^)} (1) 

Here, qi, o 2> Si. and ^ 2 each are parameters, coi has a value close to 
the anti-resonance frequency, and o 2 has a value close to the 
resonance frequency. ^1 and ^ 2 are arranged to be small, according to 

10 the anti-resonance and resonance peaks. According to this technology, 
since it is possible to restrain the gain of the resonance peak of the 
mechanical system by the filter 12, the gain can be raised more than 
in conventional cases, and high accuracy control can be realized. 

However, this technology is mainly directed less at the 

15 resonance peak illustrated in Fig. 7, than at restraining the unstable 
resonance peak at higher frequencies, and it is inexpedient to apply 
this technology to stable resonance peaks such as in Fig. 7. The 
reason for this inexpediency is explained below. 

Fig. 9 illustrates the frequency response of the filter 12 in 

20 cases where this technology is applied to a mechanical system having 
frequency response illustrated by the full lines in Fig. 7. Since the 
filter 12 is adjusted to have characteristics, the reverse of the 
anti-resonance/resonance characteristics of the mechanical system as 
described above, the gain characteristic has a peak at the 

25 anti-resonance of the mechanical system and has a trough at the 



resonance of the mechanical system. The case where the disturbing 
torque acts on the mechanical system controlled using this type of 
filter will be looked at. The resonance frequency is a frequency at 
which the mechanical system vibrates easily, and when the disturbing 
torque acts, the mechanical system may vibrate at the resonance 
frequency. This vibration is detected by the speed detection means 5 
and is fed back to the speed control means 7; the speed control means 
7 generates and outputs an electrical current command in order to 
stop this vibration. A signal component at the resonance frequency is, 
of course, included in this electrical current command. However, since 
the gain of the filter 12 becomes small at the resonance frequency as 
illustrated in Fig. 9, by passing through the filer 12, the signal 
component at the resonance frequency ends up being removed from 
the electrical current command. That is, the signal component for 
stopping the vibration ends up being removed, by the filter 12 from 
the electrical current. As a result, the disadvantage occurs that even 
when the mechanical system vibrates at the resonance frequency, the 
speed control system cannot stop this vibration. 

As described above, when controlling a mechanical system of 
low rigidity and where the inertial moment J of the mechanical 
system is large in comparison to the inertial moment JM of the motor, 
there have been problems in that it is difficult to make the gain large 
at low frequencies with the conventional generally-used speed control 
device, and speed fluctuations due to disturbing torque become large 
so that high accuracy control is difficult. 
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Furthermore, the technology disclosed in Japanese Laid Open 
Patent Publication 2000-322105 enables the gain to be made large at 
low frequencies but cannot stop mechanical vibration, so that it could 
not be applied to mechanical systems having mechanical vibration at 
low frequencies. 

DISCLOSURE OF THE INVENTION 
The present invention is directed at solving the above 
problems and has as an object the provision of a motor control device 
for controlling, stably and with high accuracy, a motor having a 
mechanical system having a resonance frequency and an 
anti-resonance frequency, and being linked to a mechanical load. 

According to a first aspect of the invention, a motor control 
device for driving, based on a speed command signal, a motor coupled 
to a mechanical load associated with a mechanical system having a 
resonance frequency and an anti-resonance frequency, the motor 
control device having in a speed control loop detection speed of the 
motor, comprises- a speed control means for outputting a drive 
command signal for the motor so as to make the speed of the motor 
conform to the speed command signal, based on a signal indicating 
the difference between the speed command signal and the detection 
speed of the motor; and a filter inserted in series with the speed 
control means in the speed control loop, the filter having 
frequency-dependent phase lag characteristics divided into a high 
frequency domain, a low frequency domain, and an intermediate 
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frequency domain between the high frequency domain and the low 
frequency domain, and in which the gain KL in the low frequency 
domain is larger than the gain KH in the high frequency domain, and 
in which the phase is delayed in the intermediate frequency domain! 
5 wherein the speed control means includes a proportional controller for 
multiplying input by a proportional gain ^Pand outputting the result, 
as well as an integral controller for adding the value of the input 
multiplied by the proportional gain KP, and the integral of the input 
multiplied by an integral gain KI^ and outputting the result; and 

10 filter settings are adjusted so that the phase of the filter is delayed at 
frequency domain between the resonance frequency and the 
anti-resonance frequency. 

According to a second aspect of the invention, a motor control 
device for driving, based on a speed command signal, a motor coupled 

15 to a mechanical load associated with a mechanical system having a 
resonance frequency and an anti-resonance frequency, detected motor 
speed being available to the device in a speed control loop, comprises* 
a speed control means for outputting a drive command signal for the 
motor so as to make the speed of the motor conform to the speed 

20 command signal, based on a signal indicating the difference between 
the speed command signal and the detected speed of the motor; and a 
filter inserted in series with the speed control means in the speed 
control loop, the filter having frequency-dependent phase lag 
characteristics divided into a high frequency domain, a low frequency 

25 domain, and an intermediate frequency domain between the high 
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frequency domain and the low frequency domain, and in which the 
gain KL in the low frequency domain is larger than the gain KH in 
the high frequency domain, and in which the phase in the 
intermediate frequency domain is delayed; wherein the speed control 
means includes a proportional controller for multiplying input by a 
proportional gain ^Pand outputting the result, as well as an integral 
controller for adding the value of the input multiplied by the 
proportional gain KP, and the integral of the input multiplied by an 
integral gain KI, and outputting the result; and filter settings are 
adjusted so that the phase of the filter is delayed between a first 
crossover frequency cjcu being the value obtained by dividing the 
product of the proportional gain and the gain KL by the inertial 
moment J of the mechanical system, and a second crossover frequency 
o>C2, being the value obtained by dividing the product of the 
proportional gain KP and the gain KH by the inertial moment JM of 
the motor. 

According to a third aspect of the invention, a motor control 
device for driving, based on a speed command signal, a motor coupled 
to a mechanical load associated with a mechanical system having a 
resonance frequency and an anti-resonance frequency, detected motor 
speed being available to the device in a speed control loop, comprises- 
a speed control means for outputting a drive command signal for the 
motor so as to make the speed of the motor conform to the speed 
command signal, based on a signal indicating the difference between 
the speed command signal and the detected speed of the motor; and a 



filter inserted in series with the speed control means in the speed 
control loop, the filter having frequency-dependent phase lag 
characteristics with an approximately constant gain KL in a 
frequency domain lower than a first filter frequency cjfu and an 
approximately constant gain KH^ smaller than the gain KL, in a 
frequency domain higher than a second filter frequency cjf2, in which 
the phase is delayed between the first filter frequency cjfi and the 
second filter frequency cjfs!^ wherein the speed control means has a 
proportional control computation means for multiplying input by a 
proportional gain KP and outputting the result, as well as a 
proportional integral control computation means for adding the value 
of the input multiplied by the proportional gain KP, and the integral 
of the input multiplied by an integral gain KI, and outputting the 
result; and filter settings are adjusted so that the ratio between an 
crossover frequency cjcu being the value obtained by dividing the 
product of the proportional gain KP and the gain KL by the inertial 
moment J of the mechanical system, and the first filter frequency ofu 
is approximately constant. 

According to a fourth aspect of the invention, a motor control 
device fox drive -controlling a mechanical system, having a resonance 
frequency and an anti-resonance frequency, made up of a mechanical 
load coupled to a motor, the motor control device by means of a speed 
control loop drive-controlling detected speed of the motor based on a 
speed command signal, comprises^ a filter inserted in series with a 
speed control means in the speed control loop, the filter having 
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frequency-dependent phase lag characteristics in an intermediate 
frequency domain between a low frequency domain and a high 
frequency domain, with an approximately constant gain KL in the low 
frequency domain being lower than a first filter frequency cjFly and 
5 an approximately constant gain KH, smaller than the gain KL, in the 
high frequency domain being higher than a second filter frequency 
€jF2i and a parameter setting means for setting parameters for the 
filter characteristics and the speed control means! wherein the speed 
control means has an integral controller for adding the value of the 

10 input multiplied by a proportional gain KP, and the integral of the 
input multiplied by an integral gain KI , and outputting the result; 
and filter settings are adjusted so that the ratio between an crossover 
frequency cjCI, being the value obtained by dividing the product of 
the proportional gain KP and the gain KL by the inertial moment J of 

15 the mechanical system, and the first filter frequency oFl, is 
approximately constant, and so that the ratio between a zero-point 
frequency apu being the value obtained by dividing the integral gain 
KI hy the proportional gain KP, and the crossover frequency oCl is 
approximately constant. 

20 According to a fifth aspect of the invention, the motor control 

device according to claim 3 or 4, is furnished with a parameter setting 
means for setting parameters for the filter and the speed control 
means, wherein the parameter setting means sets the parameters so 
that, if an inertial ratio, being the value obtained by dividing the 

25 inertial moment J of the mechanical system by an inertial moment JM 
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of the motor, is large, the ratio of the second filter frequency a>F2 to 
the first filter frequency cjfi will be large. 

According to a sixth aspect of the invention, the motor control 
device according to claim 3 or 4, is furnished with a parameter setting 
5 means for setting parameters for the filter and the speed control 
means, wherein the parameter setting means inputs to the filter a 
gain ratio, being the ratio between the gain KL and the gain KH, or a 
frequency ratio, being the ratio between the second filter frequency 
(m)f2 and the first filter frequency (dfu to set the parameters for the 

10 filter characteristics based on the gain ratio or the frequency ratio. 

According to a seventh aspect of the invention, a motor 
control device for driving, based on a speed command signal, a motor 
coupled to a mechanical load associated with a mechanical system 
having a resonance frequency and an anti-resonance frequency, 

15 detected motor speed being available to the device in a speed control 
loop, comprises' a speed control means for outputting a drive 
command signal for the motor so as to make the speed of the motor 
conform to the speed command signal, based on a signal indicating 
the difference between the speed command signal and the detected 

20 speed of ^the motor; a filter inserted in series with the speed control 
means in the speed control loop, the filter having 
frequency-dependent phase lag characteristics divided into a high 
frequency domain, a low frequency domain, and an intermediate 
frequency domain between the high frequency domain and the low 

25 frequency domain, and in which the gain KL in the low frequency 



domain is larger than the gain KH in the high frequency domain, and 
in which the phase in the intermediate frequency domain is delayed; a 
frequency response acquisition means for acquiring frequency 
response of the mechanical system; and a parameter setting means for 
setting characteristics of the filter; wherein the parameter setting 
means, based on the frequency response of the mechanical system 
acquired by the frequency response acquisition means, parameterizes 
the filter characteristics so that between the anti-resonance frequency 
and the resonance frequency of the mechanical system phase in the 
filter is delayed. 

As described above, according to the first aspect of the 
invention, since the filter is set so that the phase is delayed between 
the resonance frequency and the anti-resonance frequency of the 
mechanical system, it is possible to enlarge the gain at low 
frequencies while maintaining the stability of the control system. By 
this means, the speed fluctuations due to the disturbing torque 
become small, and the effect is obtained of being able to realize 
high-accuracy control. 

According to the second aspect of the invention, the setting is 
carried aut so that the phase is delayed between the first crossover 
frequency wCl, being the value obtained by dividing the product of 
the proportional gain KP and the gain KL by the inertial moment J of 
the mechanical system, and the second crossover frequency g)C2, 
being the value obtained by dividing the product of the proportional 
gain KP and the gain KL by the inertial moment JM of the motor 
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system. In this way, since the increase in the phase lag at the first 
crossover frequency qCI and the second crossover frequency g)C2 
becomes small, it is possible to make the gain at low frequencies large 
while maintaining the stability of the control system. By this means, 
5 the speed fluctuations due to the disturbing torque become small, and 
the effect is obtained of being able to realize high-accuracy control. 

According to the third aspect of the invention, since the filter 
is set so that the ratio of the crossover frequency qCI, being the value 
obtained by dividing the product of the proportional gain KP and the 

10 gain KL by the inertial moment J of the mechanical system, and the 
first filter frequency (oFl, is approximately constant, the increase in 
the phase lag at the first crossover frequency coCl becomes small, the 
stability is no longer weakened, and the effect is obtained that the 
control system does not vibrate or oscillate. 

15 According to the fourth aspect of the invention, since the 

filter is set so that the ratio of the crossover frequency qCI, being the 
value obtained by dividing the product of the proportional gain KP 
and the gain KL by the inertial moment J of the mechanical system, 
and the first filter frequency wFl, is approximately constant, and also 

20 since the ratio of the zero-point frequency coPI, being the value 
obtained by dividing the integral gain KI by the proportional gain KP, 
and the crossover frequency wCl is approximately constant, the phase 
lag at the first crossover frequency coCl does not become too large, 
and the effect is such that the stability of the control system can be 

25 ensured. 
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According to the fifth aspect of the invention, since the 
parameter setting means configures so that, when the inertial ratio, 
being the value obtained by dividing the inertial moment J of the 
mechanical system by the inertial moment JM of the motor, becomes 
large, the ratio of the second filter frequency qF2 against the first 
filter frequency qFI is large, the increase in the phase lag at the 
second crossover frequency (oC2 becomes small, the stability is no 
longer weakened, and the effect is obtained that the control system 
does not vibrate or oscillate. 

According to the sixth aspect of the invention, a gain ratio, 
being the ratio of the gain KL and the gain KH, or the frequency ratio, 
being the ratio of the second filter frequency qF2 and the first filter 
frequency qFI, is input to the parameter setting means, and the filter 
characteristics are set based on the gain ratio or the frequency ratio, 
so that even in cases where the mechanical system has a plurality of 
mechanical resonances, the phase lag at the first crossover frequency 
(oCl or the second crossover frequency g>C2 does not become too large, 
and the effect is obtained of being able to enlarge the gain at low 
frequencies while maintaining stability. 

According to the seventh aspect of the invention, the 
parameter setting means configures so that the filter phase is delayed 
between the anti-resonance frequency and the resonance frequency of 
the mechanical system based on the frequency response of the 
mechanical system acquired by the frequency response acquisition 
means, so that the phase lag of the filter is cancelled by the phase 
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advance of the mechanical system. As a result, the phase lags at the 
first crossover frequency wCl and the second crossover frequency a)C2 
do not become large, and even when the filter is inserted, the effect is 
obtained that the stability is no longer weakened. 

5 

BRIEF DESCRIPTION OF DRAWINGS 
Fig. 1 is a block diagram illustrating a configuration of a 
control device for an embodiment of the present invention; 

Fig. 2 is a graph illustrating frequency response of a phase 
10 lag filter, being an embodiment of the present invention; 

Fig. 3 is a graph illustrating frequency response of a speed 
open-loop according to the embodiment; 

Fig. 4 is a block diagram illustrating a configuration of the 
control device according to another embodiment of the present 
15 invention; 

Fig. 5 is a block diagram illustrating a configuration of the 
control device according to another embodiment of the present 
invention; 

Fig. 6 is a block diagram illustrating a configuration for a 
20 conventional speed control device; 

Fig. 7 is a graph illustrating frequency response of a speed 
open-loop applied to the conventional speed control device; 

Fig. 8 is a block diagram illustrating a configuration for the 
conventional speed control device for a mechanical system having a 
25 mechanical resonance; and 
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Fig. 9 is a graph illustrating frequency response of a filter 
used in the conventional technology. 

BEST MODE FOR CARRYING OUT THE INVENTION 
5 Embodiment 1 

A first embodiment of the present invention is explained by 
referring to the configuration block diagram of a control device 
illustrated in Fig. 1. 

In Fig. 1, identical reference numerals are used for members 

10 that are identical or equivalent to those in Fig. 1, and corresponding 
explanations are omitted. In the figure, reference numeral 1 denotes a 
motor, reference numeral 2 denotes a load driven by the motor, and 
reference numeral 3 denotes an axle connecting the motor 1 and the 
load 2. The load 2 represents a moveable member of a machine driven 

15 by the motor 1, modeled as one inertial load, and the axle 3 models a 
mechanism for transmitting torque, generated by the motor 1, to the 
machine. Reference numeral 4 denotes an encoder as a position 
detection means, attached to the motor 1, for detecting the position of 
the motor 1, reference numeral 5 denotes a speed detection means for 

20 computing the motor 1 speed by differentiating the motor position 
detected by the encoder 4. Reference numeral 6 is a comparator for 
comparing a speed command signal given by a high-level controller 
(not illustrated in the figure) with the detected speed (detected speed 
signal) of the motor 1, being the output of the speed detection means 5, 

25 and for outputting the difference between these two speeds as a speed 



error (speed signal deviation.) Reference numeral 7 is a speed control 
means that, with the speed error output by the comparator 6 as input, 
outputs an electrical current command that is a drive command signal 
for the motor 1. Reference numeral 8 is an electrical current control 
means that, by controlling the motor electrical current based on the 
electrical current command output by the speed control means 7, 
generates torque in the motor and rotates the motor 1. 

The speed control means 7 is composed of a proportional 
controller 9, an integral controller 10, and an adder 11. The 
proportional controller 9 multiplies the input speed error by 
proportional gain KP and outputs the result; the integral controller 

10 multiplies the integral value of the speed error by integral gain KI 
and outputs the result as the electrical current command. The adder 

11 adds the proportional controller 9 output and the integral 
controller 10 output, and outputs the result as the electrical current 
command. Further, reference numeral 15 is a mechanical system 
having a resonance frequency and an anti-resonance frequency, and is 
comprised of the motor 1, the load 2 and the axle 3. Reference 
numeral 13 is a phase lag filter that is inserted serially with the 
speed control means 7 in the speed loop, and with the output of the 
speed control means 7 as its input, performs filtering compiitation 
and outputs an electrical current command; reference numeral 14 is a 
parameter setting means for setting characteristics of the phase lag 
filter and the integral gain KI that is a parameter of the speed control 
means. 
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Here, the speed loop is a loop formed from the speed control 
means 7, the phase lag filter 13, the electrical current control means 8, 
the motor 1, the encoder 4, and the speed detector 5. 

The phase lag filter 13 is a filter having phase lag 
5 characteristics as illustrated in Fig. 2. That is, it has an 
approximately constant gain KL at frequencies below a first filter 
frequency qFI (a low frequency domain); it has an approximately 
constant gain KH smaller than the gain KL above a second filter 
frequency coF2 (a high frequency domain); and its gain varies 

10 continuously between the first filter frequency qFI and the second 
filter frequency coF2. In Fig. 2, KH = 1 = 0 db. The phase 
characteristics are such that the phase is delayed between the first 
filter frequency gdFI and the second filter frequency (oF2, and the 
phase lags are zero or have a low value at frequencies below the first 

15 filter frequency wFl and above the second filter frequency qF2. A 
filter having these types of frequency response may be realized, for 
example, by a filter having a transfer function as given in equation 
(2). 

G f(s) = (s + 02)/(s + oi) (2) 
20 Here, co ^ = qFI, co 2 = wF2. However, co 1 < 2- 

The first filter frequency qFI and the second filter frequency 
qF2, which determine the characteristics of the phase lag filter 13, 
are set by the parameter setting means 14 as below. First, the first 
filter frequency (oFl and the second filter frequency g)F2 are computed 
25 according to the equations below. 
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ocl = Kp X KL/J (3) 
G)c2 = Kp X KH/JM (4) 
Here, KP = proportional gain of the speed control means 7, 
KL = low frequency gain of the phase lag filter 13, KH = high 
5 frequency gain of the phase lag filter 13, J = inertial moment of the 
mechanical system 15, JM = inertial moment of the motor 1. 

Equation (3) and equation (4) can be derived in the following 
way. At low frequencies below the anti-resonance frequency, the 
transfer function of the mechanical system 15 can approach 1/Js. 
10 Furthermore, since the gain of the phase lag filter 13 at low 
frequencies becomes KL, considering that the proportional gain of the 
speed control means 7 is KP, the speed open-loop transfer function at 
low frequencies approximates to KP x KL/Js, However, since the 
integral gain of the speed control means 7 is small, its influence is 
15 ignored. The frequency where this transfer function gain becomes 0 
db is KP KL/J, and since this is the first crossover frequency (oCl, 
equation (3) is obtained. 

In the same way, the transfer function of the mechanical 
system 15 at high frequencies above the resonance frequency can be 
20 approximated to 1/JMs, and since the gain of the phase lag filter 13 at 
high frequencies is KH, the speed open-loop transfer function at high 
frequencies approximates to KP KH/JMs. 

The frequency where this transfer function gain becomes 0 db 
is KP KH/JM, and since this is the second crossover frequency qC2, 
25 equation (4) is obtained. In the parameter setting means 14, the first 



filter frequency oFl and the second filter frequency g)F2 are set so 
that the phase at the phase lag filter 13 is delayed between the first 
crossover frequency coCl and the second crossover frequency coC2 
given by equation (3) and equation (4). 

The speed open-loop frequency response for cases where the 
phase lag filter 13 is inserted in the speed loop in this way, and also 
for cases where it is not inserted, are compared in Fig. 3. In Fig. 3, 
the full line indicates the frequency response for cases where the 
phase lag filter 13 is inserted in the speed loop, and the broken line is 
for cases where it is not inserted. Since the phase lag filter 13 has a 
characteristic such that its gain is large at low frequencies, by 
inserting the phase lag filter 13 in the speed loop, it is known that the 
gain becomes large at low frequencies. Since, by making the gain 
large at low frequencies as described above, speed fluctuations due to 
disturbing torque become small, by inserting the phase lag filter 13, it 
becomes possible to realize good accuracy control. 

Furthermore, in order to have the control system operating 
stably, it is necessary that the phase lags of the first crossover 
frequency qCI and the second crossover frequency g)C2 be small, as 
described above. Since, as in the phase lag filter 13 mentioned above, 
in order that the phase lags at the first crossover frequency g)C2 and 
the second crossover frequency idC2 be small, the first filter frequency 
(oFl and the second filter frequency coF2 are set, the increase in the 
phase lag at the first crossover frequency wCl and the second 
crossover frequency Ci)C2 is small, and the stability of the control 



system is not weakened. That is, if the first filter frequency qFI and 
the second filter frequency g)F2 of the phase lag filter 13 are set by 
the parameter setting means 14 as described above, the stability of 
the control system is not weakened, the gain at low frequencies can be 
enlarged, and it becomes possible to realize high accuracy control. 

Moreover, the exact value of the first crossover frequency 
(oCl and the second crossover frequency u)C2 in Fig. 3 cannot be 
determined unless the speed open-loop frequency response are 
actually measured, but it is possible to perform approximate 
computations with equation (3) and equation (4). 

Next, concrete processing contents of the parameter setting 
means 14 will be explained. First, so that the ratio of the first filter 
frequency g)F1 and the first crossover frequency wCl is approximately 
constant, the first filter frequency (oFl is set. As an example, the first 
filter frequency coFl is set to be about l'^2 times the first crossover 
frequency oCl. As illustrated in Fig. 2, since the phase lag in the 
phase lag filter 13 becomes small at frequencies below the first filter 
frequency coFl, if the setting is performed in this way, the increase in 
the phase lag at the first crossover frequency wCl becomes small, the 
stability is not weakened, and the control system does not vibrate or 
oscillate. 

Next, when a inertial ratio, being the value obtained by 
dividing the inertial moment J of the mechanical system 15 by the 
inertial moment JM of the motor 1, becomes large, the second filter 
frequency G)F2 is set so that the ratio of the second filter frequency 



G)F2 to the first filter frequency wFl becomes large. As an example, 
the second filter frequency qF2 is set to the product of the square root 
of the inertial ratio and the first filter frequency coFl. The second 
filter frequency qF2 may be set to be about 1/2-- 1 times the second 
crossover frequency (oC2. By making the settings in this way, the 
second filter frequency g)F2 has a value of the same range or smaller 
than the second crossover frequency (oC2. As illustrated in Fig, 2, 
since the phase lag in the phase lag filter 13 becomes small at 
frequencies above the second filter frequency (oF2, if the setting is 
performed in this way the increase in the phase lag at the second 
crossover frequency g)C2 becomes small, the stability is not weakened, 
and the control system does not vibrate or oscillate. 

Furthermore, the parameter setting means 14 sets the 
integral gain KI so that the ratio of the zero point frequency qPI, 
being the value obtained by dividing the integral gain KI by the 
proportional gain KP in the speed control means 7, and the first 
crossover frequency oCl is approximately constant. For example, in 
order that the zero point frequency qPI be 1/2 of the first crossover 
frequency coCl, the following equation may be applied: KI = KP x cjCl 
/ 2. Since- the size of the phase lag at the first crossover frequency coCl 
that arises in the integral controller 10 is decided by the ratio of the 
approximate zero point frequency qPI and the first crossover 
frequency coCl, if the ratio of the zero point frequency coPI and the 
first crossover frequency wCl is appropriately set, the phase lag at 
the first crossover frequency cjCI does not become too large, and it is 



possible to maintain the stability of the control system. That is, if the 
integral gain KI is set so that the ratio of the zero point frequency qPI 
and the first crossover frequency coCl has an appropriate value, the 
integral gain KI can be made large within a range in which the 
stability of the control system is maintained, and the restraining 
effect on disturbances at low frequencies is enlarged. 

Embodiment 2 

Fig. 4 is a block diagram illustrating a configuration of the 
control device according to another embodiment of the present 
invention. Identical reference numerals are used for members that are 
identical to those in Fig. 1, and corresponding explanations are 
omitted. In Fig. 4, reference numeral 16 denotes a parameter setting 
means for setting characteristics for the phase lag filter and the 
integral gain KI, being a parameter for the speed control means; its 
operations are approximately the same as for the parameter setting 
means in Fig. 1 but one of the adjustment parameters a has to be 
input from outside. 

This adjustment parameter a indicates the ratio of the gain 
KL against the gain KH at high frequencies, for the phase lag filter 
13. In the parameter setting means 16, using the adjustment 
parameter a, with KL = a x KH, the first crossover frequency wCl is 
computed using the above equation (3). Further, as described above, 
the first filter frequency (oFl is set so that the ratio of the first filter 
frequency oFl and the first crossover frequency wCl is approximately 
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constant. The second filter frequency qF2 is set so that KL = a x KH. 

Regarding the way the adjustment parameter a is given, 
firstly a = 1. The mechanical system is then operated, and while 
viewing its response characteristics, a is gradually increased. If a 
5 preferable response is obtained, or if mechanical vibration starts and 
the increasing of the parameter a is stopped, in cases where the 
preferable response is obtained, the value of a is fixed, and in cases 
where the vibration starts, a is made a little smaller and fixed. By 
providing the adjustment parameter a in this way, the gain can be 

10 enlarged at low frequencies while maintaining the stability of the 
control system, and restraining effects against disturbances can be 
increased. The reason for this is explained below. 

First, when the adjustment parameter a is made large, since, 
by KL = a X KH, the gain KL becomes large at low frequencies in the 

15 phase lag filter, restraining effects against disturbances at low 
frequencies become large. Further, at this point, since the ratio of the 
first crossover frequency (oCl and the first filter frequency (oFl is 
made approximately constant, as described above, the phase lag at 
the first crossover frequency (oCl does not become too large, and the 

20 gain at low frequencies can be made large while maintaining stability. 

Further, the second filter frequency g)F2 is set so that the 
relationship between the gain KL at low frequencies and the gain KH 
at high frequencies, for the phase lag filter 13, is such that KL = a x 
KH. As will be understood by looking at the filter characteristics in 

25 Fig. 2, in order to enlarge a, being the ratio of the gain KL at low 



frequencies to the gain KH at high frequencies, it is necessary to 
enlarge the ratio of the second filter frequency (oF2 to the first 
frequency coFl. When a is made large, from KL = a x KH, KL becomes 
large; and with this, by equation (3), the first crossover frequency (oCl 
becomes large, and furthermore, since the ratio of the first crossover 
frequency qCI and the first filter frequency coFl becomes 
approximately constant, the first filter frequency oFl becomes large, 
and therefore, the second filter frequency coF2 also becomes large. 
When the first filter frequency coFl and the second filter frequency 
G)F2 become large, since the frequency range in which the phase in the 
phase lag filter 13 is delayed moves to the high frequency side, the 
phase lag for the second crossover frequency g)C2 becomes large. 

In this way, when the adjustment parameter a is gradually 
enlarged from 1, the phase lag at the second crossover frequency qC2 
correspondingly becomes larger, little by little. However, if the phase 
lag at the second crossover frequency (oC2 becomes too large, the 
mechanical system begins to vibrate, and this can be seen by looking 
at the response of the mechanical system. 

Therefore, if the value of a is set to be a little smaller than 
that at which the vibration of the mechanical system starts, the phase 
lag at the second crossover frequency ci)C2 also does not become too 
large. In this way, the characteristics of the phase lag filter 13 can be 
set so that the phase lags at both the first crossover frequency coCl 
and the second crossover frequency (oC2 do not become large, and the 
stability of the control system can be maintained. 
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The parameter setting means 14 for the speed control device 
in Embodiment 1, illustrated in Fig. 1, operates effectively for cases 
where the mechanical system has a resonance/anti-resonance set. 
However, according to the mechanical system, it may have other 
5 resonance/anti-resonance characteristics at higher frequencies, and 
for such mechanical systems it is difficult to accurately compute the 
second crossover frequency g)C2. In such cases, rather than compute 
the second filter frequency g)F2 and automatically perform setting, 
more preferable characteristics can be effectively obtained by 

10 performing the setting while viewing the response of the mechanical 
system using the adjustment parameter a. 

Furthermore, in the above description the adjustment 
parameter a indicates the gain ratio, being the ratio of the gain KL at 
low frequencies to the gain KH at high frequencies for the phase lag 

15 filter 13; however, it may also indicate the frequency ratio, being the 
ratio of the second filter frequency qF2 and the first filter frequency 
oFl. The relationship between the gain ratio and the frequency ratio 
is decided by the transfer function of the phase lag filter 13, so that 
the same effect is obtained whether the gain ratio is indicated or the 

20 frequency ratio is indicated. 

Embodiment 3 

Fig. 5 is a block diagram illustrating a configuration of the 
control device according to- another embodiment of the invention. The 
25 same reference numerals are used for members as in Fig. 1. In Fig. 5, 
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reference numeral 17 denotes a frequency response acquisition means 
for acquiring frequency response of the mechanical system, reference 
numeral 18 denotes the parameter setting means for setting the 
characteristics of the phase lag filter; and the characteristics of the 
5 phase lag filter are set based on the frequency response of the 
mechanical system acquired by the frequency response acquisition 
means 17. 

Several methods are known for acquiring the frequency 
response of the niechanical system by the frequency response 

10 acquisition means 17. Measurement may be performed using a 
specialized measurement device, or the motor may be driven at 
random torques and a frequency analysis can be carried out on the 
corresponding speed response. Further, in cases where the rigidity, 
mass, inertial moment, and the like, for the mechanical system, are 

15 known, a numerical model is made using these, and the computation 
can be performed. A result, such as the frequency response indicated 
by the full line in Fig. 7, can be obtained. In the parameter setting 
means 18, based on the frequency response of the mechanical system 
acquired in this way, the characteristics of the phase lag filter 13 are 

20 set so that the phase of the phase lag filter 13 is delayed between the 
anti-resonance frequency and the resonance frequency of the 
mechanical system. To do this, the first filter frequency g)F1 of the 
phase lag filter is set in the neighborhood of the anti resonance 
frequency and the second filter frequency g)F2 is set in the 

25 neighborhood of the resonance frequency. 
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As illustrated by the full line in Fig. 7, the frequency 
response of the mechanical system having mechanical resonance has a 
characteristic such that the phase is advanced between the 
anti-resonance frequency and the resonance frequency. Therefore, if 
5 the setting is such that the phase of the phase lag filter 13 is delayed 
between the anti-resonance frequency and the resonance frequency, 
as described above, the phase lag of the phase lag filter is cancelled 
by the phase advance of the mechanical system. Thus, the phase lags 
at the first crossover frequency cjCI and the second crossover 
10 frequency g)C2 do not enlarge, and even when the phase lag filter 13 
is inserted, the stability is no longer weakened. 

INDUSTRIAL APPLICABILITY 
The above described invention may be applied to control 
15 systems where the inertial moment of a mechanical system driven by 
a motor is large in comparison to the inertial moment of the motor 
itself. 



